Finding Displacement in Simple Harmonic Motion